

> 


/A/ - 3 7 


/ y 6 7/S" 



AUTOMATIC CALIBRATION OF SPACE BASED 
MANIPULATORS AND MECHANISMS 


A FINAL REPORT 
for 

GRANT NJ& 9-192 


Submitted to 


Charles R. Price 
Teleoperator Systems Branch 
Nasa Johnson Space Center 
Houston, Texas 77058 


by 


Louis J. Everett 

Mechanical Engineering Department 
Texas A&M University 
College Station, Texas 77843 


January 6, 1987 to June 5, 1988 


(AASA-CR- 1828C4) AD1CBATIC C 21 JFBAlIOli CF N88-25912 

SFACF BASFE BANUILATCRS A AD AICtAKISMS 
Final Report, 6 Jen. 1987 - 5 Jun. 1988 

(lexas A6B Uriv.) 81 f CSCL 131 Unclas 

G3/37 0146715 



AUTOMATIC CALIBRATION OF SPACE BASED 
MANIPULATORS AND MECHANISMS 


A FINAL REPORT 
for 

GRANT NAS 9-192 


Submitted to 


Charles R. Price 
Teleoperator Systems Branch 
Nasa Johnson Space Center 
Houston, Texas 77058 


by 


Louis J. Everett 

Mechanical Engineering Department 
Texas A&M University 
College Station, Texas 77843 


January 6, 1987 to June 5, 1988 


CONTENTS 


1 EXECUTIVE SUMMARY 1 

l.lThsk Overview 1 

1.1.1 Redundant Manipulator Calibration 1 

1.1.2 Closed Loop Manipulator Calibration 1 

1.1.3 Study of Calibration Models 2 

1.1.4 Using Single Point Sensors 3 

1.2 Travel Supported by the Grant 3 

l.SBibliography Generated from the Grant 4 

1.4Future Plans 5 

1.4.1 Nonkinematic Models 5 

1.4.2 Numerically Different Calibration Models 5 

1.4.3 Existence and Uniqueness of Solution 6 

1.4.4 Using Calibration for Fault Isolation 6 

1.4.5 Closed Loop Calibration - Continuation 6 

2 TECHNICAL REPORT 7 

2.1 Introduction 7 

2.1.1 Types of Calibration 8 

2.1.2 Forward Calibration 9 

2.2 Redundant Manipulator Calibration 11 

2.2.1 The Calibration Algorithm 11 

2.2.2 Example 13 

2.2.3 Conclusions 18 

2.3 Calibration of Closed Loop Manipulators 19 

2.3.1 Modeling 19 

2.3.2 The Objective Function 21 

2.3.3 Critical Points of the Objective Function 24 

2.3.4 Model Completeness 27 

2.3.5 Example 28 

2.3.6 Conclusions 33 

2.4A Study of Calibration Models 35 

2.4.1 Redundant Parameters 36 

2.4.2 Testing for Redundant Parameters 37 

2.4.3 Basis Independent Calibration Model 39 

2.4.4 Essential Model Parameters 41 


l 




2.4.5 The Special Case When Joint j is Revolute 44 

2.4.6 The Special Case When Joint j is Prismatic 46 

2.4.7 Summary 47 

2.4.8 Discussion 47 

2.4.9 Example 51 

2.4.1 (Conclusions 56 

2.5 Using Single Point Sensors 58 

2.5.1 Single Point Sensors 58 

2.5.2 Completing the Calibration Using a Single Point Sensor 61 

2.5.3 Example 64 

2.5.4 Conclusions 74 


ii 


LIST OF FIGURES 


1 

2 

3 

4 

5 

6 

7 

8 

9 

10 
11 


12 

13 

14 

15 

16 


A Seven Joint Manipulator 13 

A Simple Manipulator With a Single Four Bar Closed-Loop 20 

Robot Used in the Example 28 

Coordinate System Placement for One Set of Input Data 30 

Body and Joint Numbering Scheme 36 

Vector Notation For Manipulator Models 40 

Appearance of Vectors Before and After Rotation 42 

Appearance of Vectors Before and After Translation 43 

Remainder of J’th Column Ater Row Operation 50 

A Complete Model for a 3 Joint Manipulator 52 

A Complete Model for a 3 Joint Manipulator Demonstrating Param- 
eter Shifting 53 

A Complete Model for a 3 Joint Manipulator Demonstrating Polar 

Coordinates 56 

The World, Tool, and Sensor Coordinate Systems 59 

A Pointer and Target Measurement System 60 

The Orientation Fixture 62 

Flow Chart of the Simulation Procedure 65 


ui 


EXECUTIVE SUMMARY 


1.1 Task Overview 

Grant NAG 9-192 supported twelve months of research comprising four related 
tasks in manipulator kinematic calibration. This section of the report summaries 
the objectives and status of each task. 

1.1.1 Redundant Manipulator Calibration 

There have been several manipulator configurations proposed for use on a space 
station. One manipulator has seven degrees of freedom, another fourteen. NASA 
personnel expressed concern about the ability to calibrate redundant degree of free- 
dom manipulators. Because of this concern we wanted to demonstrate that redun- 
dant manipulators present no unique problems. 

Calibration of a seven degree of freedom manipulator has been simulated. Cal- 
ibration of redundant manipulators presents no unique difficulties. 

Calibration is a regression problem in which several unknown parameters are 
chosen to minimize error between a calculated and measured tool location [1]. As 
an optimization problem, it remains well defined regardless of the number of joints 
and measurements. 

1.1.2 Closed Loop Manipulator Calibration 

There is increased interest in the study of direct drive manipulators because they 
reduce (or eliminate) several non-geometry sources of error such as backlash and 
gear harmonics. In addition, they produce much higher stiffnesses. Because direct 


drive electric manipulators require very large motors, they are sometimes impracti- 
cal. To overcome this problem, designers have utilized mechanism transmissions to 
produce optimal power transmission from motor to linkage. For example, Bajpai 
and Roth [2] analyzed the basic kinematic geometry and workspace properties of 
a simple five-bar-closed-loop robot. There are many examples of closed-loop joint 
actuation manipulators in commercially available systems. Some manipulators de- 
signed by GMF and Cincinnati Milacron have linkage transmissions. 

This work presents a calibration model that can be applied on a closed-loop 
robot. It is an expansion of open-loop kinematic calibration algorithms subject 
to constraints. A closed-loop robot with a five-bar linkage transmission has been 
tested. Results show that the algorithm converges within a few iterations. 

1.1.3 Study of Calibration Models 

This study formalizes the concept of model differences. Differences are catego- 
rized as structural and numerical; structural differences are emphasized here. The 
work demonstrates that “geometric” manipulators can be visualized as points in a 
vector space with the dimension of the space depending solely on the number and 
type of manipulator joints. Visualizing parameters in a kinematic model as the 
coordinates locating the manipulator in vector space enables a standard evaluation 
of the usefulness and accuracy of various manipulator models. Key results include 
a derivation of the maximum number of parameters necessary for models, a formal 
discussion on the inclusion of extra parameters, and a method to predetermine a 
minimum model structure for a kinematic manipulator. 


1.1.4 Using Single Point Sensors 


Single point sensors can measure the position of only one point fixed to the ma- 
nipulator’s end effector. When single point sensors have been used for calibration, 
it has not been possible to calibrate the orientation of the tool. Furthermore, it has 
often been difficult to calibrate the sensor system. Results in the literature seldom 
provide a complete calibration of the manipulator. Presented here is a technique 
that enables single point sensors to gather sufficient information to complete the 
calibration. In addition, the method can also reduce the burden of calibrating the 
sensor system itself. 

1.2 Travel Supported by the Grant 

In December 1987, the principal investigator attended the ASME Winter Annual 
Meeting in Boston. One objective of the visit was to evaluate interest in the subject 
of robot acceptance tests. A paper session on the general topic of acceptance testing 
for manipulators has preliminary approval from the chairman of the Robotics panel 
of the Dynamic Systems, Measurement, and Control division of ASME. The princi- 
pal investigator intends to organize an acceptance testing session in an appropriate 
upcoming conference. 

In March 1988, the principal investigator attended the Joint Applications in 
Instrumentation, Process, and Computer Control mini symposium held at the Uni- 
versity of Houston, Clear Lake. The objective was to remain current with robotics 
and automation pertaining to space applications. 

In April 1988, the principal investigator and graduate student Cheng- Yang Lin 
attended the IEEE Robotics and Automation Conference in Philadelphia. The 
objectives of the trip were to present two papers generated from grant money. Both 
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papers were well received, each inspired several questions and discussion. In addition 
to presenting the papers, the principal investigator contributed to a half day short 
course on manipulator calibration which also was well received. 

In May 1988, the principal investigator visited NASA Marshall Space Flight 
Center. The trip’s objectives were to present research results, become familiar 
with Marshall’s activities, and discuss possibilities for continued NASA support. 
The trip resulted in a better understanding of NASA’s ground based automation 
requirements. 

1.3 Bibliography Generated from the Grant 

To date, six papers generated from grant support, have been submitted for 
publication and two have appeared in print. The papers, Kinematic Calibration of 
Manipulators with Closed Loop Actuated Joints, and A Study of Kinematic Models 
for Forward Calibration of Manipulators have appeared in Volume 2 of the 1988 
IEEE International Conference on Robotics and Automation Proceedings. 

Two journal versions of the former papers have been submitted for publication. 
The papers Forward Calibration of Closed Loop Jointed Manipulators and Similarity 
in Structurally Different Kinematic Models in Forward Calibration were submitted 
to the International Journal of Robotics Research. Reviewers comments have 
not been received to date. 

Another paper titled: Completing the Forward Kinematic Calibration of Open 
Loop Manipulators When Single Point Position Sensors are Used has been submit- 
ted to the Journal of Robotic Systems. Reviewers of the paper asked for specific 
changes and resubmission. The changes are nearly complete at this time. 

Lastly, a conference paper titled: A New Method for Calibrating the Final Ori- 


entation Parameters of a Manipulator has been submitted for publication at the 
1988 Winter Annual Meeting of ASME. 


1.4 Future Plans 

This section briefly discusses five projects which are planned for the near future. 

1.4.1 Nonkinematic Models 

Kinematic calibration models for open and closed loop manipulators are well 
understood. Reported results from this grant have shown how structurally different 
kinematic models of manipulators can be compared. Future work is to develop 
similar theory for so called nonkinematic models. 

Nonkinematic models will be studied by allowing the constant parameters in 
kinematic models to vary. Each constant will be expressed as a series function 
of quantities including joint positions, load, and velocity. Careful choice of the 
series functions used should enable the development of a generic calibration model 
representing a superset of currently existing models. 

The project currently has one student assigned to it but is not funded. 

1.4.2 Numerically Different Calibration Models 

The reported results on structural differences in kinematic models will be ex- 
tended to numerical differences. The work may provide new understanding about 
how nearly singular points affect calibration, and manipulation tasks. Addition- 
ally, the work may discover the causes of ill-conditioned calibration Jacobians. This 
knowledge relates to locating calibration measurement devices in the workspace and 
inverse kinematic solutions. 


Numerical differences are currently being studied by the principal investigator. 


1.4.3 Existence and Uniqueness of Solution 

Although calibration algorithms generally converge there is no formal proof that 
calibration solutions are unique. Solution existence can be assured through proper 
problem definition but uniqueness remains a problem. This ongoing work will at- 
tempt to determine the conditions which guarantee unique solutions. The problem 
is being addressed using convex sets, and stability theories. 

1.4.4 Using Calibration for Ebult Isolation 

Calibration results can be used for detecting faults in a manipulator. If, for 
example, a joint position sensor is providing incorrect output. It may be possible to 
perform a quick calibration to detect the faulty sensor. This process was performed 
to a small extent by Mooring and Pack [3]. Currently this work is not funded nor 
being investigated although it may have considerable impact on NASA operations. 

1.4.5 Closed Loop Calibration - Continuation 

The closed loop mechanisms calibration project is not complete. It has been 
shown that it is possible to calibrate manipulators having closed loops but there 
remains several areas to be investigated. For example, the singularities arising when 
the loops axe nearly planar need to be better understood. A formulation which 
models internal forces may also be important. Fundamental to all future closed 
loop calibration work will be a sensitivity study to determine when calibration is 
required and what improvement can be achieved using calibration. 


Part 2 

TECHNICAL REPORT 


2.1 Introduction 

The configuration of a manipulator is specified one of two ways: (1) by a set of 
joint variables or (2) by the tool position and orientation (the pose [4]). There is 
typically one measurable joint variable for each degree of freedom of motion. The 
joint measurement usually consists of the relative displacement of each joint. Pose 
can be specified by a 4 by 4 homogeneous transform ( w T t ) [5]. Because tool position 
feedback is uncommon, it may be impossible to measure tool pose accurately during 
motion. Manipulators that do not have accurate measurements of tool pose are often 
operated in a teach playback mode, where an operator places the end effector in 
a desired position and the controller “remembers” the joint configuration. During 
manipulation, the controller replays the memorized sequence of joint configurations. 
It may be possible (even in the absence of pose measurement) to specify pose rather 
than teaching if one mathematically relates pose to joint position. This can be done 
with a kinematic model [5]. When utilizing a kinematic model, the controller relies 
on accurate joint positioning for accurate tool positioning. 

A recognized problem with kinematic models is their unsatisfactory accuracy. 
For various reasons [6,7], including manufacturing tolerances, accurate mathemat- 
ical relations between tool pose and joint configurations axe difficult to obtain. 
Manipulator calibration has been proposed as a means for reducing the error in the 
mathematical relation between joint positions and tool pose. A complete discus- 
sion of calibration can be found in Whitney, Lozinski, and Rourke [6], Chen and 
Chao [8], Mooring and Tang [7], Hyatti [9] Stone, Sanderson, and Neuman [10], 


Everett, Driels and Mooring [1], and Everett and Hsu [11]. 


2.1.1 Types of Calibration 

As pointed out by Roth, Mooring, and Ravani [12], the term calibration repre- 
sents three significantly different processes. Level I, joint level calibration, consists 
of calibrating the joint feedback sensors. The homing process on some manipula- 
tors with incremented joint encoders is Level I calibration. A variation of Level I, 
workspace calibration, is the process of determining the position and orientation 
of the mechanism base relative to a fixture holding the manipulated objects. A 
discussion of workspace calibration can be found in [13]. Level I calibration is rel- 
atively simple and does not require sophisticated measurement devices. Level II 
calibration (the subject of this research) is the calculation of an accurate mapping 
between joint position and tool pose by measuring this relationship at a certain 
number of locations and performing a regression analysis to fit model parameters 
to the measurements. Level III calibration, dynamic calibration, is the calculation 
of inertia and similar terms that affect the motion of the tool. 

A further subdivision of Level II calibration is discussed by Whitney, Lozinski, 
and Rourke [6] and Shamma and Whitney [14]. Like the inverse kinematic problem, 
inverse calibration seeks a direct relation with tool pose as input and joint position as 
output. There are two advantages of inverse calibration: (1) the error sources need 
not be known, and (2) results do not require an inverse kinematic solution. A major 
disadvantage is that inverse calibration requires extensive position measurements. 
Considering the current expense of measurement, the method may not be suitable 
for some applications. 

Forward calibration [6,7,8,9,10,11,12,15] assumes a model based on assumptions 


of error sources and attempts to determine the “best fit” set of model constants 
that causes the computed tool pose to approximate measured pose. There are two 
advantages of forward over inverse calibration: (1) it may require fewer measure- 
ments, and (2) it gives insight to the sources of error, which can be valuable when 
fed back to the manipulator designer. This research addresses forward calibration 
only. 


2.1.2 Forward Calibration 

The first step in performing forward calibration is to choose a model that is 
assumed capable of relating joint to tool configurations. Authors usually present 
their version of a kinematic model and proceed. Because numerical results differ 
with each model, results are difficult to compare. 

It is assumed that a manipulator is characterized by a set of constants (e.g. 
Hartenberg-Denavit constants [5]) called parameters. These parameters typically 
consist of rigid body transformations, including translations such as link lengths, 
and rotations such as twist angles. Parameters can be specified by screw opera- 
tors [7]. The yth parameter of a manipulator whether it is a rotation or translation 
is refered to as Cj. The complete set of parameters is referred to collectively as the 
vector C. A specific manipulator is characterized by listing a set of parameters as 
in C = (Ci ,. .. ,C m ) where m is the number of parameters. Since the manipula- 
tor’s joints are lower pair, joint i, lying between bodies i and i + 1, moves along or 
rotates about a single line specified with unit vector n The set of joint variables 
is referenced collectively as 0. 

Most algorithms discussed in the literature are intimately tied to a particular 
modeling strategy. The software used in this study was written with the ability 


to model and calibrate manipulators in a variety of ways. The software has been 


used with several of the popular modeling techniques such as those of Whitney [6], 
Chen [8], Hayati [15], and Everett and Hsu [16]. 


2.2 Redundant Manipulator Calibration 


The objective of the redundant manipulator calibration task was to demonstrate 
that redundant manipulators can be calibrated. The calibration problem was sim- 
ulated since a redundant manipulator was unavailable. A seven degree of freedom 
manipulator similar to a PUMA arm was calibrated. 

The calibration problem differs significantly from inverse kinematic problems. In 
inverse problems, one must calculate joint positions corresponding to a desired pose 
of the tool. This pose specification consists of six given quantities (constraints). 
If the number of joints (free variables) is less than six, it may not be possible to 
satisfy all the constraints. If the number of joints is greater than six, as for re- 
dundant manipulators, there will be an infinite number of solutions. In calibration, 
however, there can be 30 free variables (for a 6 degree of freedom PUMA) these axe 
constrained to produce minimum error between measured and calculated manipu- 
lator pose. Hence, calibration is a regression problem and therefore is well defined 
regardless of the number of free variables. 

2.2.1 The Calibration Algorithm 

The pose of a manipulator’s tool can be expressed as a four by four transforma- 
tion matrix T„, see Paul [5]. It is common that one computes the pose of a tool as 
a product of matrices, A, each fixed to a link of the robot. 

T a = AiA? • • • Ai • • • A n (1) 

The four by four matrix A\ is the relationship between successive link fixed coor- 
dinate systems. One well known convention for such matrices is the Hartenberg- 
Denavit transformation [17]. It is easily understood that different manipulator 


configurations and sizes have different A, matrices. 

Let dT be the differential change between the measured T matrix, T m , and the 
calculated T matrix, T a : 


and define ST 0 as: 


dT = T m - T 0 
dT = T 0 ST 0 


( 2 ) 

( 3 ) 


Here 6T 0 means a differential change of the calculated T matrix relative to the 
coordinates of the tool. Kinematic calibration is the process of choosing parameters 
in Ai so that dT approaches zero. The solution is found iteratively. 

Using first order terms of a Taylor series to relate dT to small changes in pa- 
rameter values, results in: 

dT - 1 i <«> «> 

Here P k represents the fc’th unknown parameter and p is the number of parameters 
(unknowns) in the model. 

It can be shown [5] that combining equations 2, 3, and 4 produces the equation: 


T~ 1 (T m - T 0 ) = ST - 


0 — Sz 6y dx 

Sz 0 — Sx dy 

—8y Sx 0 dz 

0 0 0 0 


= WP] 


( 5 ) 


Here ST is thought of as an error between actual and calculated tool location, [dP] 
is a vector of kinematic parameter errors, and [J] is a Jacobian matrix (contain- 
ing partial derivatives) relating [dP] and ST. Quantities dx, dy, and dz are the 
translation errors between computed and measured positions, Sx, Sy, and Sz are 
the orientation errors. 

For each measurement, at most six independent equations can be extracted 
from equation 5. Therefore, if there are n parameters to identify, there must be 
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a minimum of n/6 = m measurements made. According to theory developed by 
Everett et.al. [1] and [11], the number of independent kinematic parameters is 6 + 
4R + 2P, where R is the number of revolute joints and P is the number of prismatic 
joints. For the case of a seven revolute joint manipulator, 34 parameters need to be 
identified. This requires a minimum of six measurements. 


2.2.2 Example 

A simulated calibration was performed for a seven joint manipulator shown in 
figure 1. The open-loop kinematic equation is constructed of transformations from 
the base to the tool which can be expressed as: 


T 0 — A$ Ai A 2 A 3 A 4 As Ay (6) 

The unknowns for this problem are the constant parameters in the A matrices. 

The solution process begins with selection of values for the unknown A matrices. 
This is equivalent to choosing the kinematics of the manipulator. The values chosen 
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(hence the correct calibration solutions) are: 




' 1 

0 

0 

0 ' 


■ C(1) 

0 

S(l) 

0 ' 


' 1 

0 

0 

0 


A - 

0 

C(2) 

— S(2) 

0 


0 

1 

0 

0 


0 

1 

0 

0 

• 


0 

S(2) 

C(2) 

0 


-S(l) 

0 

C(l) 

0 


0 

0 

1 

.67 



0 

0 

0 

r 

1 


0 . 
_ 1 r . 

0 

0 

1 


0 

0 

0 

1 



L 



' 1 0 

J 

0 

L 

0 


■ 1 

0 

0 

o' 





0 1 

0 

0 


0 

1 

0 

0 





0 0 

1 

0 


0 

0 

1 

0 

• 




0 0 

0 

1 


0 

0 

0 

1 



■ C(0x) 

— 

S(*i) 

0 

0 ' 


1 

0 

0 

0 ' 


A — 

S(*0 

C(*i) 

0 

0 


0 

1 

0 

0 



0 


0 

1 

0 


0 

0 

1 

0 

• 


0 


0 

0 

1 


0 

0 

0 

1 


1 


0 


0 


0 


0 C(— 90) — S( — 90) 0 
0 S(— 90) C(— 90) 0 

0 0 0 1 


1 0 0 .05 1 
0 10 0 
0 0 10 
0 0 0 1 


( 7 ) 


( 8 ) 




A = 


' C(0 2 ) - 

-S(0 2 ) 

0 0 



o 

o 

r—» 

.42 ' 


1 

0 

0 

0 ' 

S(0 2 ) 

C(0 2 ) 

0 0 



0 1 0 

0 


0 

1 

0 

0 

0 

0 


1 0 



0 0 1 


0 


0 

0 

1 

0 

0 

0 


0 1 



0 0 0 


1 


0 

0 

0 

1 

I 1 0 


0 

0 1 


r 

C(— 2) 

0 

s 

- 

2) 

0 ' 



0 C(2) 

- 

-S(2) 0 


0 

1 


0 


0 



0 S(2) 

C(2) 

0 


— S( — 2) 

0 

C(- 

2) 

0 



0 0 


0 

1 


L 

0 

0 


0 


1 



'C(0 3 ) - 

-S(0 3 ) 

0 0 

■ 


10 0 

0 1 


' 1 

0 

0 

0 ' 

S(0 3 ) 

C(e 3 ) 

0 0 



0 1 0 


0 


0 

1 

0 

0 

0 

0 


1 0 



0 0 1 

.17 


0 

0 

1 

0 

0 

0 


0 1 



0 0 0 


J 


0 

0 

0 

1 



' 1 

0 


0 

0 ' 









0 

C(90) 

— S(90) 

0 









0 

S(90) 

C(90) 

0 









0 

0 


0 

1 








( 9 ) 


( 10 ) 


14 


» 


( 11 ) 


' 1 

0 

0 

0 ‘ 


' 1 

0 

0 

0 ‘ 


■ C(-2) 

0 

S(— 2) 

0 ' 

0 

1 

0 

0 


0 

C(l) 

-S(l) 

0 


0 

1 

0 

0 

0 

0 

1 

*4 


0 

S(l) 

C(l) 

0 


-s(— 2) 

0 

C(— 2) 

0 

0 

0 

0 

1 


0 

0 

0 

1 


0 

0 

0 

1 


■ C(M 

— 

S(0 s ) 0 0 


' 1 

0 

0 

0 



1 

0 

0 

0 ' 

S(*s) 

<w 

0 0 


0 

1 

0 

0 



0 

1 

0 

0 

0 


0 

1 0 


0 

0 

1 

.1 



0 

0 

1 

0 

0 


0 

0 1 


0 

0 

0 

1 



0 

0 

0 

1 



■ 1 

0 


0 


0 ' 








0 

C(— 90) 

-S( 

-90) 

0 








0 

S(— 90) 

C(- 

-90) 

0 








0 

0 


0 


1 






■ C(0 6 ) 

-S(* 6 ) 

0 0 ' 


1 

0 

0 

0 



' 1 

0 

0 

0 ■ 

S(0 6 ) 

C(0s) 

0 0 


0 

1 

0 

0 



0 

1 

0 

0 

0 


0 

1 0 


0 

0 

1 

.05 



0 

0 

1 

0 

0 


0 

r 

0 1 


0 

0 

0 

1 

-1 



0 

0 

0 

1 


10 0 0 

0 C(90) — S(90) 0 

0 S(90) C(90) 0 

0 0 0 1 


( 12 ) 


( 13 ) 



■ C(0 7 ) 

-S(*) 

0 

0 ' 


' 1 

0 

0 

0 


' 1 

0 

0 0 ■ 

A — 

S(d 7 ) 

C(0 7 ) 

0 

0 


0 

1 

0 

0 


0 

1 

0 0 


0 

0 

1 

0 


0 

0 

1 

.25 


0 

0 

1 0 


0 

0 

0 

1 


0 

0 

0 

1 


0 

0 

0 1 

1 0 1 

0 0 1 

[1 0 


c 

1 0 

1 

[ 

C(— 2) 

0 

S( 

-2) 


0 1 0 .05 
0 0 10 
0 0 0 1 


0 C(l) -S(l) 0 
0 S(l) C(l) 0 
0 0 0 1 


0 


0 0 


— S(— 2) 0 C(— 2) 0 
0 0 0 1 


( 14 ) 


A forward kinematic solution is performed using the correct A matrices to cal- 


culate the relation between input joint values and the pose of the tool. The input 
angles were chosen as: 
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In an actual calibration, one would position the manipulator and measure the 
joint angles and tool pose. 

With the simulated calibration data, the calibration is performed. This requires 
computing the partial derivatives of the kinematic equations. In addition, the al- 
gorithm requires an initial estimate of the unknowns. The initial estimates are: 
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With this data, the algorithm was used to estimate the correct parameters. 
After convergence, the two norm of the difference between estimated and correct 
parameters was 2.7069719 x 10 -29 . 


2.2.3 Conclusions 

The problems of calibrating redundant manipulators axe fundamentally the same 
as nonredundant manipulators. As a result there is no need to study redundant 
manipulator calibration as a separate issue. 
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2.3 Calibration of Closed Loop Manipulators 


A method for performing forward kinematic calibration of manipulators with 
one or more closed-loop actuated joints is presented. Closed loop manipulators are 
unique from conventional manipulators. Closed loop manipulators may contain ball 
and socket joints and develop significant internal forces. 

The technique used for calibration is an extension of the algorithm designed 
for open-loop jointed manipulators and is equivalent to minimizing a constrained 
objective function. The constraints arise from the closed-loop mechanisms in the 
manipulator. The objective function is taken as the integral of end effector position 
and orientation error and the closed loop constraints are dealt with using the method 
of Lagrange multipliers. 

2.3.1 Modeling 

Since forward calibration is investigated, the model is expressed such that joint 
position is input and tool pose is output. In addition to expressing tool pose, 
it is necessary to express each closed-loop because the tool relationship must be 
consistent with the physical constraints of the mechanism. 

The component of the model relating joint configuration to tool pose is the 
open-loop transformation, T„. The component expressing the closed-loop is the 
closed-loop transformation, T c . There are several methods for expressing these 
transformations; we use four-by-four homogeneous transformation matrices. In this 
case, the open-loop equation is written: 



Figure 2: A Simple Manipulator With a Single Four Bar Closed-Loop. 

The T c transform has the form: 

T c = A cl A C2 ---A Ci ---A 0n = [I] (24) 

Again A>, and Ac t represent homogeneous matrices. There is one equation like 
equation 24 for every closed-loop in the mechanism. Although equations 23 and 24 
appear simple, they are nonlinear functions of a large number of unknowns. 

Three types of quantities may appear in equations 23 and 24. The first type is 
the set of measurable joint positions (0); the second is a set of imprecisely known 
constants (C); the third is a set of unmeasurable variables (a). 

Note the two-dimensional manipulator shown in figure 2. Although the math- 
ematics applies to a much more general class of three-dimensional high degree of 
freedom manipulators, this simple example clarifies the concepts. In the two di- 
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mensional manipulator, an open-loop transformation could have the form: 
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Here C(0) and S(0) denote cos(0) and sin(0), respectively. 
The closed-loop transformation could have the form: 
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(26) 

In these equations, 0 = o = (ai , a 2 ,a 3 ), and 

C = (Xo^YoiZojLi^zjLz^Li^Ls^A). 


2.3.2 The Objective Function 

The calibration problem is to determine the unknowns in equations 23 and 24. 
The unknowns axe selected by minimizing the square error between model predicted 


and measured tool pose. Although pose is computed by a four-by-four homogeneous 
matrix, it is convenient to represent error as a six by one vector of the individual 
errors. 

If tool pose is computed by equation 23, and measured pose is expressed as T m , 
pose error can be expressed as: 

= § fc 1 (X- - r.)] (27) 

The last matrix in equation 27 has the same form as in equation 5. Therefore the 
operator S [] from equation 27 can be defined as: 

5 [T- 1 (r m - T a )\ = (dx/l, dy/l,dz/l,6x,6y, Sz) T (28) 


where l is a normalizing length. Since F is a function of joint position, it varies 
over the workspace; hence a scalar objective function is defined as an integration 


over the entire workspace: 


'-£i 


F^FdO 


Since it is impractical to compute the integration, it is approximated as a summation 
over joint positions. After simplification, the objective function becomes: 

f = £ 2 A A .<?) ( 30 ) 

i=l * 

Here m represents the number of joint sets or measurements used in the calibration. 
Since not all variables in equation 30 are independent, the objective function must 
be minimized subject to the constraints, T c . This can be done several ways. 

One method for dealing with constrained optimization problems is to solve the 
constraints explicitly for the dependent variables and substitute these into the ob- 
jective function. This is difficult but has been successfully performed in some mecha- 
nism design cases [18]. The advantage of this technique is that it reduces the number 
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of variables in the optimization problem. The disadvantage is that the constraints 
are not easy to solve explicitly. 

Another method for solving constrained optimization problems is penalty weight- 
ing, which has been used in mechanism design problems [19]. With the penalty 
weighting method, the constraint equations are expressed as: 


O = A^5 t [T c -[/]]5[r c -[/]]d0 


(31) 


The objective function is modified: 

f ' = L[\ prp ^ l2; - 17)1 - Ml 


<20 


(32) 


where A is a large arbitrarily chosen constant. As A increases, any solution not 
satisfying the constraints highly penalizes the objective function. The technique 
differs from the Lagrange multiplier method [20] in that A is chosen arbitrarily. 
This difference results from the restriction that the Lagrange multiplier method is 
valid only when the optimum of the modified objective function is not an extremum 
of the constraint equations. Because the constraint equations are a squared form, 
the optimal solution of the objective function is also a minimum of the constraint 
equations; hence the restriction is violated. Two advantages of the penalty weighting 
method are (1) it introduces no unknown variables, and (2) it does not require 
explicit solutions to the constraint equations. A disadvantage is that as A increases, 
the profile of the objective function tends toward a deep, narrow, long valley which 
can cause the iterative solution process to oscillate and converge slowly [21]. 

The method chosen for this work is the Lagrange multiplier technique. To apply 
this method, the constraints are modified to: 


o = >X S) S{T C - (/)) 


(33) 
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Note that in this case A is an unknown vector function of 0. These unknown 
functions number six times the number of closed-loops. The objective function is 
also modified as: 

S' = l F + % S) S % - (/)]] d@ = Af g) G (34) 

The unknowns in equation 34, a, C, and A^ are treated as independent. The 
modified objective function is discretized to become: 

/- = sr=,{[i^ A ^ iA)?) + 


2.3.3 Critical Points of the Objective Function 

The relative maximums or minimums of the objective function are located at 
the critical points of the function. The critical points of the objective function are 


defined by: 


'»» {f t ^9F_ + Xt _dG 1 _ _ 

' ,=1 1 {®ifii,c) dC T ^ (Qi)QQT I 


p t _ dF , jfr dG_ -r _ g ' ,ib ' 

(Oj£i,C)fcjF + / \©>)da T 7 ; ~ u 

G&iAifi) = 4 =° 

The terms represent the partial derivatives of a column vector v with respect 
to a column vector u>, which is a matrix with row t column j given as The 

free subscript j in equation 36 assumes numbers from one to to. 

The Newton iteration process is used to solve equations 36 for the critical point. 
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The iterative equations can be expressed as: 

-a = EE, [fee+ (5 (k+1)i - «„) 

+ fe F + _+ fe 4 . (<v.) - 4) 

+G^- (X(k+i)i - A.;] 

-7« = fe^ + + ferX) fey - Sky) (37) 

+ fee + e?-f> + <fe*),y (feo - 4) 

(\fc+i)y - Xty) 

-Aky - G s r (d(fc+i)y - Sky) + Gp-T (<?(fc + .) — 4 ) 

The subscript k represents estimates at the k iteration. In equation 37, a comma 
represents partial differentiation; the free variable j represents the j joint configu- 
ration. Consider the bilinear terms such as (F^F)^-, to be interpreted as a matrix 
in which the r c element equals ^ F j . The term Fi is the l row of F, cir 

is the r row of a, and p c is the c row of C . 
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It is possible to arrange equations 37 into the following matrix form: 
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(38) 

Here X implies a nonzero matrix, and (F^-) . = ^F^F + F^F^t + C?~tA).. 
Other terms are defined similarly. The square block symmetric matrix in equa- 
tion 38 differs from the Jacobian matrices used in the calibration of open loop 
manipulators [7,10,11,22]. Even if one throws out all terms involving the constraint 
equations, the bilinear terms remain. These bilinear terms do not appear in stan- 
dard open-loop calibration Jacobians. Since the purpose of the Jacobian is simply 
to predict a new estimate for the unknowns, it need not be exactly correct. Note 


that the square matrix in equation 38 is the Hessian matrix for the original objective 
function. As such, it plays an important role in the study of the uniqueness of the 
critical point. When interpreted as the Hessian matrix, it is imperative to include 
the bilinear terms. Since this study simply identifies unknowns producing a critical 
point, the bilinear terms are discarded to reduce unnecessary numerical difficulty. 



where x represents the vector of constrained unknowns of the problem. Note that 
x contains a and some C. The inverted matrix in equation 39 will be nonsingular 
if the constraint equations ( G ) can be used to uniquely determine the constrained 
quantities. Unfortunately, this is not always the case for calibration. For exam- 
ple, consider the manipulator with a single closed-loop planar four bar mechanism 
shown in figure 2. If the manipulator is modelled with complete three-dimensional 
transformations throughout, there must be six constraint equations (three position 
and three orientation) to guarantee that the single loop remains closed. With the 
formulation used here, 6m Lagrange multipliers would be introduced. Since there 
are only three unknown variables in the loop, there will be only 3m + C independent 
constraints, where C is some constant. We know C must be constant because there 
is a finite number of design variables in any mechanism [18]. This implies that 
potentially not all the 6m Lagrange multipliers can be uniquely, determined. This 


manifests itself in the fact that 


is singular. In any case, an optimal solution 


can be obtained, but the solution algorithm must deal with singular matrices. 
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Figure 3: Robot Used in the Example. 


2.3.5 Example 


The algorithm described was used to identify a manipulator with a five-bar 
actuated joint (Figure 3). Links one and four are inputs driven by two motors fixed 
to the base. For simplicity, the closed-loop mechanism is assumed to cause only a 
two dimensional motion at point P on the tip of the arm. The manipulator can 
move in three dimensions with a rotation axis on joint 0. 

The open-loop kinematic equation is constructed of transformations from the 
base to joint one, then to joints two and three, and finally to point P. The closed- 
loop equation can be expressed as a product of transforms from joint three to joints 
four, five, one, two, and finally back to joint three. These axe expressed as: 

T 0 = A g A x A> 

(40) 

T c = A J A t A i A l A 7 

The unknown variables in this problem are the angles between links one and 
two, two and three, and three and four. The measurable angles are assumed to 
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be about joints zero, one and five. Since the closed-loop produces only planar 
motion, it is possible to reduce the number of constraints from six to three, thereby 
requiring only three Lagrange multipliers per measurement. This simplifies the 
problem tremendously and avoids the problems of a singular Jacobian matrix. The 
unknowns for this problem are the constant parameters in the A matrices, plus 
three Lagrange multipliers and three unknown angles per measurement. 

The solution process begins with selection of values for the unknown A matrices. 
This is equivalent to choosing the kinematics of the manipulator. The values chosen 
(hence the correct calibration solutions) are: 

1 0 0 0 C(0 O + 180) — S(0 O + 180) 0 0 1 0 0 4.5 

0 10 0 S(0o + 180) C(6 0 + 180) 0 0 0 1 0 0 

0011 0 0 10 0010 
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0 C(— 90) — S(— 90) 0 S(180) C(180) 0 0 
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0 0 0 1 0 0 0 1 
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Figure 4: Coordinate System Placement for One Set of Input Data. 


A = 


A = 


C(a 3 ) -S(a 3 ) 0 0 

S(a 3 ) C(a 3 ) 0 0 

0 0 10 

0 0 0 1 


4 = 




0 

0 

4 ' 


0 

1 

0 

0 


0 

0 

1 

0 

J i 

0 

0 

0 

1 


C(0 2 ) -S(0 2 ) o 0 ' 


1 0 0 9' 


s( 0 2 ) c( 0 2 ) o 0 


0 10 0 


0 0 10 


0 0 10 


0 0 0 1 

t 

0 0 0 1 



C(180) — S(180) 0 0 
S(180) C(180) 0 0 

0 0 10 
0 0 


10 0 0 
0 10 0 
0 0 10 
0 0 0 1 


0 1 


( 45 ) 


(46) 


(47) 


Figure 4 shows the appearance of the coordinate systems for one set of input 
data. A forward kinematic solution is performed using the correct matrices to 
calculate the relation between input joint values and the position of point P. The 
input angles chosen and the corresponding positions of P are: 
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This data is a simulation of the actual measurement process. In an actual 
calibration, one would position the joints and measure the input angles and the 
position of the end effector. 

With the simulated calibration data, the calibration process is applied. This 
requires computing the partial derivatives of the open and closed-loop kinematic 
equations. In addition, the algorithm requires an initial estimate of the unknowns. 


















































































The initial estimates are: 
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' C(2) — S(2) 0 0 1 0 0 .1 
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With this data, the algorithm was used to estimate the unknowns. After nine 
iterations, the algorithm produced an objective function of the order 10 -14 and all 
Lagrange multipliers were computed as zero. 

2.3.6 Conclusions 

An algorithm has been presented that can kinematically calibrate closed-loop 
manipulators. The algorithm is equivalent to minimizing a constrained objective 
function. The chosen objective function was the error between the measured end 
effector pose and the kinematically calculated pose. Error was expressed as the 
Euclidean norm of the difference in pose integrated over the entire workspace. For 
practical reasons, the integration was reduced to a discrete sum. 

Constraint equations arise because the closed-loop must remain closed for all 
joint configurations. The constraints appear as nonlinear algebraic restrictions on 
the kinematic equations. In general, there axe six constraints per closed-loop. For 
practical reasons, the constraints are approximated as individual constraint equa- 
tions applied to discrete joint configurations. This causes the number of constraint 
equations to equal six times the number of measurements used in the calibration. 

Since the constraint equations cannot be easily inverted, the method of Lagrange 
multipliers was used. By modifying the objective function, the constrained opti- 
mization is treated as a unconstrained problem. The disadvantage of this is that 
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the number of unknowns increases. 

The method was successfully applied to two and three dimensional manipulators, 
a simple five-bar actuated joint mechanism was included as an example. Although 
the example demonstrated that the technique has application, more research is 
needed. Problems to be investigated include those associated with very large op- 
timization problems, determining the required number of parameters, and dealing 
with internal forces. In addition, more research is needed to better understand the 
singular conditions arising from planar and nearly planar mechanisms. 


2.4 A Study of Calibration Models 


Many of the publications dealing with calibration introduce a new kinematic 
model. Because results differ, conclusions concerning the utility of the models are 
difficult to formulate. This part of the report formalizes model differences thereby 
enabling model comparison. 

A manipulator is considered to be a system consisting n + 1 rigid bodies. One 
end of the manipulator is the world, and is called body 1; the tool is numbered 
n -f- 1 and intermediate bodies are numbered sequentially with body 2 connected 
to the world via joint 1 see figure 5. Manipulators are characterized by a set of 
constants called parameters, which typically consist of rigid body transformations. 
Parameters may also be specified by screw operators [7]. The jth parameter of a 
manipulator whether it is a rotation or translation is denoted Cj. The complete 
set of parameters is referred to as vector C. A specific manipulator is characterized 
by listing a set of parameters as in C = (Ci, . . . ,C P ) where p is the number of 
parameters. Since the manipulator’s joints axe lower pair, joint i, lying between 
bodies i and i + 1, moves along or rotates about a single line specified with unit 
vector Hi. The set of joint variables is referenced as 0. A forward kinematic model, 
referred to as the function F[C,0] = F[(Ci,. ,C7 P ),0], calculates the pose of a 

tool held by a manipulator. 

Models of manipulators can differ. These differences axe either structural or 
numerical. Structural differences axe the result of a different number, type, or order 
of parameters. For example, a model with a rotation parameter followed by a 
translation is structuredly different from a model with a translation followed by a 
rotation. Numerical differences arise from using different numerical values for the 
parameters. We emphasize that the models F 4 [C,,0] and F P [C P ,Q\ are structurally 
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i 

I 
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Figure 5: Body and Joint Numbering Scheme. 

different by the subscripts s and p. Only structural differences are studied. 

Two manipulators are identical if they pose a tool exactly alike for identical 
joint variables. A model exactly matches a manipulator if it exactly predicts the 
pose of a tool held by the manipulator for all values of the joint variables. Two 
manipulators -Fi[Ci,0] and ^[C^,©] are called nearby if ||.Fi[(7i,0] — F 2 [C , 2,0]|| is 
small for all 0. 


2.4.1 Redundant Parameters 


All parameters for a particular model structure can be classified as either redun- 
dant or essential. A parameter Cj is redundant relative to C = [C \ , . . . , Cj , . . . ,C P ) 
if there are numbers (Cl ,. . . ,C*) and a positive number 6 such that: 
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for any e,- < 8 for all 0. Essential parameters include all parameters that are not 
redundant. It is easy to show that if parameter Cj is redundant relative to C, it is 
also redundant relative to C* , where C and C* are defined in 55. Redundancy must 
be expressed as relative to a set of parameters because it is possible for a parameter 
to be redundant relative to one set of parameters, and essential relative to another. 

The significance of essential parameters is that all such parameters in a model 
must be known precisely. To demonstrate this consider the following. Suppose a 
robot is modelled exactly as 

F„[(C 1 ,...,C i ,...,C p ),0] = F.[C,0] 


and we wish to calibrate a model. Beginning with a nearby model with the same 
structure 

we modify all parameters but Cj in an attempt to make our model match the 
manipulator. After this process our model appears as: 

F 4 [(C' 1 *,...,C7 J + e j ,...,C;),0] 

By definition, if it is possible that: 


F,[(C’ 1 ,...,C i ,...,C' p ),0] = F.[(C;,...,C J +e i ,...,C7;),0] 


parameter Cj must be redundant relative to the manipulator F 4 [C,0]. If not, the 
equality cannot exist and our result cannot model the manipulator exactly. 


2.4.2 Testing for Redundant Parameters 

To develop a necessary and sufficient condition for redundant parameters, con- 
sider two nearby models given by F a [C + e, 0] ~ F a [(7,0]. Since forward kinematic 
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models contain parameters appearing alone or as arguments in forward trigono- 
metric functions, they are everywhere continuous with respect to the parameters. 
Because they are continuous, it is possible to expand one model in a Taylor series. 
After expansion, the two nearby models axe related by: 

F a [C +Z, 0] = F,[C\ + Cl,. . . ,Cj + . . ,C p + Cp,©] 


F. [C, C i C„,0] + EL, J 


(56) 


+ 


Rewriting and keeping only the first order terms, we obtain: 

dF, 


F 4 [C + e,0]-F 4 [C,©]«£ 

k=\ 


dC k 


c,e] 




(57) 


If there are redundant parameters relative to C, it is possible that the two nearby 
models are exactly the same. If so 

/ r 

8F. 


[o] = £ 

fc=i 


dC k 


c,& J 




(58) 


is satisfied for all choice of 0. Although 


M - 

dCk 


represents a 4 by 4 matrix, it is 


possible to rewrite equation 58 as a 16 row by p matrix times the p by 1 vector e by 
forming a row in the equation for each term in the original 4 by 4 matrix. Although 
it is impossible to express equation 58 for all possible values of 0, it is possible to 
construct several equations using different values of 0. If this is done for m values 
of the joint variables, the equation becomes: 


[ 0 ] = 


‘ Ml 
dC k 

C,0! 

dF c 

at 

C,0 m . 


e = [J]e 


(59) 


In this equation, [J] is 16m by p. If there are redundant parameters then there will 
be a nontrivial solution for e and [J] must have rank less than p. Since all nontrivial 


solutions lie in the null space of [«7], the number of redundant parameters equals 
the rank of the null space of \J). Conversely, the number of essential parameters is 
equal to the rank of [J]. This test is only sufficient because one can never express 
equation 59 for all possible values of 0. 

2.4.3 Basis Independent Calibration Model 

To demonstrate that equation 59 has a maximum rank regardless of the model 
structure used, review equation 57. Divide equation 57 by a small pseudo time 
increment At and take the limit as At approaches zero. In the limit, equation 57 
represents the derivative of JF’fC',©] with respect to t. If the parameters C are 
considered functions of t, equations 57 and 59 can be written as: 

At 1 dt 

Physically, equation 60 is a velocity equation for a large degree of freedom system 
in which the model parameters C are functions of time and contribute to the motion 
of the tool. Note that equation 60 differs from the conventional velocity of the 
manipulator since conventional velocity is the time derivative with respect to the 
joint variables. To avoid confusion, equation 60 is called the “extended velocity” 
equation. Also note that = C is constant relative to joint variables 0. 

Equation 60 is rewritten using vector mechanics since velocities can be expressed 
as vectors. For example, the time derivative of the ith rotational parameter which 
is applied in the jth body of the model structure (after the application of joint 
variable j — 1 but before joint variable j) is expressed as uJj. Derivatives of the ith 
distance parameter applied in the jth body is expressed as v 1 -. The sum of v 1 - over 
i is represented as Vj. The quantity Oj represents the number of uJj terms located 
in body j. 



39 



Figure 6: Vector Notation For Manipulator Models. 


With standard kinematic formula, the extended angular and linear velocities of 
the tool for a single joint configuration can be written as: 

•fi* = Z7±l (e£, «}) = EJS % 

( 61 ) 

W V B = £»« jv- + Y_°^ [<Sj. X (,'«»' + r 


E denotes a coordinate system fixed in the tool (end effector) that represents the 
Cartesian position of the manipulator. P'- represents a point on the line of action 
of cJj, and hence is fixed in body j, see figure 6. Qj is any point on the (j-l)st joint 
after the joint variable; hence Qj is fixed in body j. The vector r A ^ B is the position 
of point A with respect to point B. Point Q*j is coincident with point Qj when the 
manipulator is in a zero position and is fixed to body j-1. Points Qj and Q* differ 
only when joint j is prismatic and the joint is displaced. Point t is located at the 
origin of E. 

Equation 61 is representative of equation 59 for a single joint configuration 
and any conceivable kinematic model, including those based on screw theory [7]. 
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Since the changes in parameters represent infinitesimal angular motions, they can 
be treated as vectors and the order of their application is irrelevant. Consider the 

special case of a Hartenberg-Denavit [17] model. The quantity f lj equals A0z-\-Aax 

■ 

and Vj equals A Iz + Arx, where z is a unit vector along the motion axis between 
bodies j — 1 and j, and the unit vector x points along the x axis. 


2.4.4 Essential Model Parameters 


Equation 61 is expressed for general joint configurations and analyzed to deter- 
mine the maximum possible rank of the Jacobian matrix. The analysis consists of 
performing row and column operations on the vectors in the equation and therefore 
it is necessary to evaluate the vectors in a common coordinate system. The end 
effector coordinate system is arbitrarily chosen for the evaluation of these vector 
quantities. 

Consider only the yth terms in equation 61: 


= --- + eS 1 ^ + 


+ fij ■ f 


•V E = ■ ■ ■ + Vj + Efc, [i 3- x (fWw + + 


(62) 


Now place the manipulator in a new joint configuration by moving or rotating every 
joint relative to its current position. For example, if joint l is revolute, then it is 
rotated Of degrees from its position corresponding to equation 62. When joint l 
rotates, all vectors appearing in the model structure after joint Is motion appear 
unchanged in the end effector frame, but vectors applied before joint l appear to 
rotate an amount —Of about joint Is rotation axis (nj) (see figure 7). This vector 
rotation is denoted by a rotation operator _®»). If joint l is prismatic, motion 
of df units changes only some position vectors. Prismatic joint motion is depicted 
in figure 8 and denoted by the operator _ d ky 


I 


» 


» 



figure 7; 


Appearance of Vector, Before 



and After Dotation. 
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2.4.5 The Special Case When Joint j is Revolute 

When all n joints of the manipulator change into the fcth joint configuration, 
the jth terms from equation 61 appear as: 

w ti E = ,-.* ) ■ ■ • Rfa, -a* H 

w v B = +e£, [3 x (?*«»■ +f «■/'’/)]} + ••. 


This assumes that the jth joint is revolute; another analysis follows demonstrating 
what happens when joint j is prismatic. By recognizing that the position vector 
ft/Qi+i is unchanged by joint j motion, equation 63 becomes: 

W Q‘ E ~ +" + 

*?■-••• + «*..-*) ■■■**, .-•!) [<$ +s2. (3 x f 0i/p/ )] + (64) 

)^j) x ’ T,/9 '*’] + •■• 

The term [t?- + x ? Q] ^ P > ) j can be lumped into a single constant vector 

called V/. 

Denoting by A 1 and .4^, components of vector A that axe respectively perpen- 
dicular and parallel to unit vector ff,, expression 64 can be written as: 

W Q E = • ■ • + %„.-«*) • * • Rp-'-ihfif + %„,-**) ’ • • %>+ 1 ,-e‘ +1 )«} + • • • 

[%., x #•■/«»■] + (65) 

[(*?)" + S|_x ;•»>««»■] + 

>^S) x + ■•■ 

It is important to observe the j + 1st terms from equation 61, which are similar 
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to the jth. terms of expression 64. When added to equation 65 the following results: 

™n E = ••• + ,-•*) •• • • R (fl, +1 ,-^ +1 )^S+ 

w v E = ••• + «(«.,-.: [p?)*] + 

[V..-*) (%.-»;>*¥) x + (66) 

[(v/)" + ^ x <*<«*»■] + 

%.-«;) • • • P*5) * f 1 + 

'W-«s>---'W..-*.> [<$♦. +z2r (?»i x ?«»•/'!♦.)] + 

[^(Sn.-9S) -*{+,) (-^(n,4i .-«)+, )^ J+I ) X r ^ 9 ' “] +'** 

By combining terms with identical rotation operators, equation 66 can be ex- 
pressed as: 

™n E = • • • + %„,-«*) • • • R ( #. i _ e k ) Sif + %„,-«*) ' • • %, +l ,_9* +l) (^j + tij+i) + ••• 

= . . . + %„.,*) • • • %,,-**) (^/) ] + 

%»,-«£) • • • %, + 1 ,- o ‘ +1 ) (^ i ) 1 + ^+1 + 

(wj +1 x f <? > +,/p i+>) + rijj x fo,+ 2 /<?, + i] + 

{%..-*>••• *w-? + ,> K +l .-^ +1 ) (<? + Ml x fe/£?j+J } + ■■ ■ • 


Since the vectors fljj and 0j +1 are constant, their sum in the first line of ex- 
pression 67 can be replaced with another constant vector ft' +1 . Similarly, through 
proper definition of other constant vectors, expression 67 can be reduced to: 

= " • + %«,-**)•" .-•*$} + %»,-**)"’ jR (n i+1 ,-9* +l )^+i + • 

[%n.-9‘) •• • %, + 1 ,-^ +I ) X ^ t/<?;+, j + 

[%.,-»*) ’ • • .-#»„) (%>+! -«* +1 )^+0 X f ' ‘ /<?J + 5 ] + ••• 
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Equation 68 is the exact form as the jth and j + 1st terms would appear in 
equation 64. This series of manipulations shows that the jth kinematic parameters 
can be decomposed into components parallel and perpendicular to the jth rotation 
axis and that the parallel components can be shifted past the rotation axis and 
combined with the original j + 1st terms. 


2.4.6 The Special Case When Joint j is Prismatic. 

When joint j is prismatic, the jth terms appear as: 

W M E — h ‘ D (ii . _ d k)Q,j -\ 

w v E = • % ,-*> {<$ + s2. [3 x + ? q ’ IP ‘ )] } + ••• 

(69) 

Since the representation of constant vectors i2 l - and Vj is unaffected by prismatic 
joint motion, these terms can be rewritten as: 

W fi E *=*•• + %« ,-*i) • • - A' + * * • 

= - + , (&t *4%) + (70) 

• ■ • JW. ,-<?„> N x fQU ‘ "’l + } + • • • 

Including the j + 1st terms as in the last section, expression 70 becomes: 

= .■■ + %„_«<.) • • • % J+1 _ek +i ) A + n j+1 ) + ••• 

m V B = * ' ' ’ + %»,-<*) • • • A >< + 

%n .-«*)••• %j+l ,-«‘ +1 ) {^' + ^+1+ ( 71 ) 

E2i x r Q UJ p l] + E2i +1 [o? + 1 x f^+«] + 

Qj x f t/<? >+ 1 1 + • • • 
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Note that all of the jth terms can be absorbed into the j -f 1st terms with the 
exception of the single quantity x d* , which represents the effect of prismatic 
joint j. 

2.4.7 Summary 

The operations described above can be performed on all the terms of equation 61 
from joint 1 through joint n. When this is done, the equation expressed for the fcth 
joint configuration takes the form: 

= -%„,-**) + %„,-**) (^a) +J-- + 

(fy'-i) + •••%.+. ,-*,*+,) (^l+i) +'•• + 

R(n ni -0ii) (^n) + ^ + i 

w V l = (^') + {%„,-**) • • • R (n 7 ,-el) [%,,-•*) (^i) ] x ft/Q2 } + 

(^2 ) [■ R (« l ,-^) (^2 ) ] X f t/Qi } + • • • + 

%«.-<*) •"%.+ ! -«,*+,) Pi X X d F™l) + ”• + 

(t) X + [%„,-,*) (ft) 1 ] x r- + t +1 

(72) 

Here joint l has been assumed to be prismatic; joints 1, 2, l — 1, / + 1, and n are 
revolute. 

2.4.8 Discussion 

Equation 72 is a representation of several rows of the Jacobian matrix defined in 
equation 59 for a single joint configuration. Using equation 72 we wish to determine 
the maximum possible rank of the Jacobian matrix. Notice that in the first of the 
two equations in 72 most of the unknowns present are perpendicular components 
of a vector. Since these perpendicular components are two-dimensional vectors, 
they total at most twice the number of revolute joints. Also note that vector 
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^n+i i s three-dimensional; hence it can contribute three independent (essential) 
unknowns. The first equation cannot determine any parameters that appear just 
before a prismatic joint, since none of the prismatic parameters appear in the first of 
the two equations. It is also impossible to use any of these equations for determining 
prismatic parameters. This last fact is consistent with published results [16]. 

Consider the second of the two equations. Again, most of the parameters ap- 
pear as perpendicular components of vectors, hence they axe two-dimensional. In 
the latter equation, there axe two dimensional vectors (Vj') and (O') for every 
revolute joint j. Because position vector changes with joint variables j + 1 

to n, these unknown vectors cannot be combined. As a result, they can produce 
four independent (essential) parameters per revolute joint. Because (f^) appears 
in the first equation, when the two equations axe taken together, the number of 
independent unknowns remains four per revolute joint. It is especially important 


that the two-dimensional vector (f corresponding to prismatic joint l appears 
only in the second equation; hence it produces two extra independent parameters 
for every prismatic joint. Also since V^' +1 is three-dimensional, it may contribute 
three extra essential parameters. Since appears only in the first equation it 

cannot be computed when only the second equation is used. 

The outcome of this analysis was predicted by Everett and Hsu [11] with a 
different approach. They gave no formal proof but suggested an equation that 
relates the number and type of joints to the number of independent parameters. 
Since the two findings are mutually supportive, their equation can formalize one 
result of this study. The maximum number of kinematic parameters that must be 
identified for any manipulator, regardless of the modelling scheme, is 


N = 4R + 2P + 6 


48 


Equation 73 shows the number of independent parameters N for a robot with R 
revolute and P prismatic joints. 

There are cases where a robot model does not have as many parameters as in- 
dicated. One explanation is that the rotation and/or the translation of the joints 
create dependencies between the otherwise independent parameters. Detailed anal- 
ysis of these occurrences requires a study of number differences of kinematic models 
and will be presented in a future work. 

One simple example of joint position prohibiting a full ranked Jacobian can be 
observed from these results. Consider what happens during row operations on the 
Jacobian matrix, for example the j th terms from equation 72 for joint configurations 
k and k -f 1. To prepare for the analysis, suppose the fcth equation is operated on 
from the left with « J+1 ,_ 0 * +1 ) •• • R^a n ,-» £)• The jth and j -fist columns appear as: 

(*%) + (*%+>) 


«,-.?> W )* + [%,-•;» («;) T * + W -.) 1 + ( fif .) 1 - 


During solution, to eliminate the j + 1st column, subtract rows k and k -f 1. The 


result will be: 


(*%) - x («i ,-«*♦') (*%) + ° 


%.-«;> (^') x + [%,-.*) («;)"] X - (75) 

(^') x - («;) 1 x + o 

Some of these vectors are depicted in figure 9. If 0j and axe the same, not 
only the j -f 1st term disappears but also the jth, thereby reducing the rank of the 
Jacobian matrix. Hence to prevent the jth unknowns from completely disappearing, 
one must guarantee that the jth joint is rotated. Likewise for prismatic joints; if the 
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joint is not moved (df = df +1 ), the unknowns just before the joint axis will disappear 
during row operations on the Jacobian matrix. This last discussion supports the 
idea that in calibration, it is important to exercise the manipulator in joint space 
to insure that the joint rotations and translation have appreciable magnitude. 

Not only has this analysis demonstrated that there is a well defined number 
of essential parameters for any manipulator, but it has also demonstrated which 
parameters they are. For example, the analysis indicates that the important pa- 
rameters should provide a two-dimensional rotation vector perpendicular to the 
immediately following revolute or prismatic axis and a two dimensional translation 
displacement vector also perpendicular to an immediately following revolute joint. 
In addition, the model must contain a three-dimensional displacement and three- 
dimensional rotation after the last motion axis. These parameters are essential, and 
any model that lacks them is not complete. 


2.4.9 Example 


Consider a three revolute joint manipulator shown in figure 10. The method of 
this paper will be used to establish calibration models which have maximum rank 
Jacobian matrices. 

One full rank model is shown in figure 10 and can be expressed as: 
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Figure 10: A Complete Model for a 3 Joint Manipulator. 


■ 1 

0 

0 

0 


' C(a z2 ) 

-S(a i2 ) 

0 

0 ' 


0 

1 

0 

e y2 


S (a z2 ) 

C(a z2 ) 

0 

0 


0 

0 

1 

L + e z2 


0 

0 

1 

0 


0 

0 

0 

1 


0 

0 

0 

1 






ri 

0 

0 




0 C(-0 2 ) -S(-0 2 ) 0 
0 S(-0 2 ) C(-0 2 ) 0 

0 0 0 1 


C(a y2 ) 0 S(a y2 ) 0 
0 10 0 
-S(a„ 2 ) 0 C(o:y 2 ) 0 
0 0 0 1 


10 0 0 


C(a z3 ) — S(a z3 ) 0 0 


0 1 0 D -f- Cy3 


S(a*3) C(a z3 ) 0 0 


0 0 1 e z3 


0 0 10 


0 0 0 1 


0 0 0 1 



f 1 0 0 

(’ 


0 C(-0 3 ) -S(-0 3 ) 0 
o s(-0 3 ) c{-e 3 ) o 
oo 0 1 


C(a y3 ) 0 S(a y3 ) 0 
0 10 0 
-S(a y3 ) 0 C(a y3 ) 0 
0 0 0 1 


» 


» 


52 


z.. 



World 

Join-t l 


Tool 


>— 1 ' 


Pnsma-tlc ___ Revalue® 
Paraneter Parameter- 

„ _ Coarcfcnate 
Axis 


Jom-t Axis 


Figure 11: A Complete Model for a 3 Joint Manipulator Demonstrating Parameter 
Shifting. 
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In this particular model, we have used a to represent an angle to be calibrated, e 
is a length to be calibrated, and 9 is a measured relative encoder angle. In all the 
models given here, the absolute zero of each encoder reading is arbitrary and can be 
conveniently selected. The model includes rotations and translations perpendicular 
to the upcoming rotation axis and is therefore complete. After joint 3 comes three 
rotations and translations. This model will have a full rank Jacobian except for 
special cases occurring, for example, when some of the a are near 90 degrees. 

Another full rank model is shown in figure 11 and can be expressed as: 
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0 

0 

1 e zl 


0 

S(a» t ) C(a xt ) 0 


- 

-S(a yt 

) 0 

C(c* yt ) 0 


0 

0 

0 1 


0 

0 0 1 




0 

0 

0 1 


C(a 2t ) -S(a 2t ) 0 0 

S(a*t) C(a 2t ) 0 0 

0 0 10 

0 0 0 1 


The unknown quantities a and e will differ from those above. This model demon- 
strates that parameters parallel with the upcoming joint axis may be shifted passed 


Another good model is shown in figure 12 and is given by: 


‘ 1 0 0 e,! ] [ 1 0 0 0 ] C(a yl ) 0 S(a yl ) O' 

0 1 0 tyi 0 C(a xl ) -S(a xl ) 0 0 10 0 

0 0 1 0 0 S(a xl ) C(a xl ) 0 -S(a yl ) 0 C(a yl ) 0 

0 0 0 1 j[0 0 -0 lj[ 0 0 0 1 

C(0i) -S(^) 0 0 ] 

S(^) C(^) 0 0 

0 0 10 
0 0 0 1 

'1 0 0 0 ] [ C(a z2 ) -S (a t2 ) 0 0 1 C(a y2 ) 0 S(a y2 ) 0 ' 

0 10 e y2 S(a z2 ) C(a z2 ) 0 0 0 1 0 0 

0 0 1 L + e z2 0 0 1 0 — S(a: y2 ) 0 C(o: y2 ) 0 

000 1 J [ 0 0 0 1 J L 0 0 0 1 

[ 1 0 0 0 1 

0 C( 0 2 + a x2 ) — S(— 0 2 + a X 2) 0 
0 S( — $2 + C( — 0 2 + 0x2) 0 

0 0 0 1 

'1 0 0 0 1 C(a z3 ) ~ S(a z3 ) 0 0 1 C(a y3 ) 0 S(a y3 ) 0 ' 

0 1 0 P + S (a, 3 ) C(a* 3 ) 0 0 0 1 0 0 

0 0 1 0 0 0 1 0 — S(a y3 ) 0 C(a y3 ) 0 

000 1 J [ 0 0 0lj[ 0 0 0 1 

[10 0 0 
o c(-e 3 ) -s(-0 3 ) o 
0 S(-tf 3 ) C(-0 3 ) o 

0 0 0 1 

' 1 0 0 e xt 1 0 0 0 1 [ C(a yt ) 0 S(a yt ) 0 ' 

0 1 0 €y t 0 C(a xt ) — S(a xt ) 0 0 10 0 

0 0 1 e zt 0 S(a xt ) C(a xt ) 0 -S(a yt ) 0 C(a yt ) 0 

0 0 0 1 J[o 0 0 lJL 0 0 0 1 

C{a zt ) —S(a zt ) 0 0 
S(a 2t ) C(a 2t ) 0 0 
0 0 10 
0 0 0 1 

This model demonstrates that a rotational parameter (a x2 ) parallel to the upcoming 
joint axis with a displacement parameter (e y3 ) perpendicular to the joint axis can 
be used as polar coordinates to replace a displacement parameter. 
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Jotrrt Axis 


CoordJna-te 

Axis 


Figure 12: A Complete Model for a 3 Joint Manipulator Demonstrating Polar 
Coordinates. 

These examples attempt to show that defining a revolute joint axis requires 
locating a point on the axis and the orientation of the axis. This can be done in a 
number of ways as shown above. 

2.4.10 Conclusions 

This formal proof that there are a maximum number of independent parameters 
in kinematic calibration models shows that the maximum number depends on the 
number and type of joints. It is possible to predetermine which parameters in a 
model are independent and which are not. 

For each revolute joint, four parameters must be determined. At least two of the 
four parameters must be rotational. The remainder must provide two translations. 
A satisfactory set of parameters can be determined if the approximate orientation of 
each joint axis is known. Two orientation parameters applied about noncolinear axes 
before and perpendicular to joint axis j should be selected for identification, and 
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two prismatic parameters applied along noncolinear axes before and perpendicular 
to joint axis j should be selected. 

For a prismatic joint, only two parameters need to be determined. The two 
parameters must be rotation parameters and should be applied about noncolinear 
axes before and perpendicular to the prismatic joint axis. 

For specifying the end effector, six parameters must be determined. These can 
be chosen as three rotational and three translation parameters applied after the last 
joint axis along three mutually perpendicular axes. 


2.5 Using Single Point Sensors 


When a manipulator is calibrated, a relation between tool pose relative to the 
world and the joint configuration is obtained. To express the tool pose relative to 
the world requires specification of at least two coordinate systems. One system, 
fixed in the world, is called the world reference frame. The other system, fixed in 
the hand or tool, is called the tool reference frame. Refer to figure 13. 

The tool and world frames must be physical, easily located systems so the user 
can specify their. Some calibration algorithms place the tool reference on the ma- 
nipulator’s last rotation axis. Although this is well defined mathematically, it is 
difficult (if not impossible) for a human operator to specify positions relative to it 
therefore should be avoided. 

A third coordinate system is the sensor reference frame. When a sensor is used 
to collect calibration data, the measured points lie in a sensor coordinate system. 
Note that in general the sensor reference can differ from the tool reference, and 
usually is fixed in the tool. Because measurements are taken using the sensor, 
calibration algorithms relate sensor pose relative to the world. In contrast, the 
ultimate objective is to compute the tool pose relative to the world. Hence it is 
sometimes necessary to relate the sensor reference to the tool, and until this is 
done, the calibration is not complete. This part of the report discusses one way this 
relation between sensor and tool frames can be computed. 

2.5.1 Single Point Sensors 

A variety of sensors have been used for forward calibration of manipulators, 
many of which measure positions of individual points. The theodolite system of 
Whitney, Lozinski and Rourke [6] is capable of determining the position of a very 



Figure 13: The World, Tool, and Sensor Coordinate Systems. 

small target sphere (a point) relative to a global reference system. Chen and Chao [8] 
use a similar device. The output of the theodolite system is a set of coordinates 
defining the position of an arbitrary point. The system of Stone, Sanderson, and 
Neuman [10] acoustically measures the position of a spark source (a point) which, 
as in the theodolite system, is arbitrarily located. Veitschegger and Wu [23] used 
a pointer device where a point (the tip of a pointer) is at a known location in the 
workspace, see figure 14. Veitschegger’s sensor system, can accurately locate the 
pointer tip only when it contacts a target location. These systems might be called 
point sensors since they locate points. Not all sensor systems axe point sensors. 
The five degree-of-freedom, laser interferometer system developed by Lau, Hocken, 
and Haynes [24] for example, measures part of a body’s orientation as well. 

It is possible to use point sensors to sense the orientation of a body by measuring 
the positions of multiple points on a stationary rigid body. This is simple math- 
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q Figure 14: A Pointer and Target Measurement System. 

ematically, but it requires a measurement system capable of measuring multiple 
points without motion of the body. A sensor capable of measuring multiple points 
® on a body will be called a multipoint sensor. The theodolite system for example is 

a multipoint sensor. 

Of main concern here are single point sensors, instruments that can determine 
® the position of only one point at a time. For example the sensor systems of Hyatti 

and Veitschegger are angle point sensors. By defining multiple target points, it 
is possible to use Veitschegger ’s sensor to determine information about multiple 

• points of the manipulator, but the system operates by locating a single point at a 
time. The reason for isolating single point sensor systems is that they can be very 
inexpensive, highly repeatable, and reliable. 

• It is convenient to classify points as either physical or nonphysical. A physical 
point can be touched, and hence measured, with conventional measurement tech- 
niques. For example, a small sphere mounted on a manipulator creates a physical 

• point. A nonphysical point cannot be touched or measured easily. For example, a 
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proximity probe usually trips when it comes within a certain distance of an object. 
The trip point is a constant distance from the object, but it is invisible and cannot 
be preset or precomputed. It will be shown that there is a simple method by which 
manipulators can be completely calibrated using nonphysical single point sensors. 

2.5.2 Completing the Calibration Using a Single Point Sensor 

The objective of forward calibration is to determine a relation between joint 
configuration and the pose of the tool or hand with respect to the world or global 
coordinate system. A sensor produces a relation of the sensor reference system 
with respect to the world because the sensor measures only the position of the 
sensor frame not the position of the tool frame. If the sensor system is physical, 
it may be possible to measure, with conventional devices, the constant relation 
between sensor and tool reference thereby allowing the computation of tool pose 
given sensor pose. If the sensor system is nonphysical, the sensor/tool pose may 
not be easy to determine. In addition, since single point sensors do not provide 
orientation information, it may not be possible to calibrate the correct orientation 
of the sensor frame. This subsection presents a method by which nonphysical, single 
point sensors can gather enough information to complete the calibration. 

To determine the sensor/tool pose, it is necessary to locate multiple points in the 
tool. A manipulator held fixture (called the orientation fixture) shown in figure 15 
has been used on a manipulator. It is possible to use three of the four physical points 
on the orientation fixture to define a coordinate system. This orientation frame 
differs from the sensor frame used for calibration. One point of the orientation 
fixture becomes the origin of the orientation frame. Another arbitrarily selected 
point defines the X axis, and a third point defines the X, Y plane. The coordinates 



Figure 15: The Orientation Fixture. 

of the four physical points of the orientation fixture are measurable and can be 
expressed as: 



Note that since the orientation frame is physical, it is easy to measure its pose with 
respect to the tool. 

Suppose a nonphysical single point sensor was used to calibrate a manipulator, 
therefore an accurate relation between joint configuration and sensor pose is avail- 
able. This relation can be expressed as the four-by-four transformation W T‘. Note 
that the relation is well defined although the sensor frame is nonphysical and cannot 
be touched. What we desire is to determine the transform W T\ which is the tool 
pose relative to the world. 
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The tool pose relative to the world can be found from: 


U> rpt wrp88 rpoorj^t 


( 77 ) 


Here w T t is unknown and desired, W T‘ can be accurately computed since we have 
calibrated the manipulator, and *T°, the pose of the orientation frame relative to 
the sensor frame is unknown but constant. The transform °T\ the pose of the tool 
relative to the orientation fixture, is measurable since both frames are physical. The 
objective is to compute the unknown transform ‘T° thereby making the computation 
of w T l possible. 

To compute the unknown transform, one can use the same single point sensor 
used for calibrating the manipulator. For example, the pointer of Veitschegger’s 
sensor could be fixed in the workspace and four targets placed on the manipulator. 
The manipulator would be driven, four separate times, so that each target on the 
manipulator is pointed to. Based on the four joint configurations corresponding 
to pointing at each target, the unknown transform can be computed as will be 
demonstrated next. 

Consider the transform equation: 


jrpO 


jr^88fj~^0 W/J~l8 


n 


a 


0 0 1 


( 78 ) 


When target i on the manipulator is brought to the fixed pointer, regardless of the 
approach direction, the target’s coordinates (also the pointer’s coordinates) can be 
expressed as: 


— ♦ 
X 

U> rps 

' ‘n° 

•o° 

“a° 

y ' 


1 

t 

0 

0 

0 

i 



( 79 ) 


The vector X is a constant but unknown position of the target relative to the 
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world. The transforms W T\ are computed from the joint configuration measured 
when target i of the manipulator is pointed at. Rewriting equation 79 yields: 


•Tf 


X 

1 


s n°S sc i + ‘o°Syi + (*n° X a o°)S z 
1 


+ 


r 

0 


(80) 


The terms S x i, S y i, and S e i axe the x, y and z components of 5». Equation 80 
represents four matrix equations, each corresponding to a different target on the 
manipulator. Combining equations 80 with 76 yields: 


(•17 - '27) 

■ X ' 
1 

( J 27 - '27) 

' X ' 
1 


fXi = 

-X 2 (‘n°) 


n 

0 


IY* 


'6° 


(81) 


m - 'r 0 ”) 


X 

i 


X 3 (‘n°)-Y 3 (‘o°)- Z 3 (‘n° x a o°y = 0 


Equations 81 can be iterated to compute the quantity X. When X is known, 
equations 80 can be used for the unknown transformation *T°. 


2.5.3 Example 

Equations 81 are solved in this subsection. To demonstrate the effects of mea- 
surement error, random normal deviates are injected into simulated data. The 
simulation process is depicted in the flow chart in figure 16. 

Recall that the single point sensor is placed in an unknown but fixed position 
X in the world reference. For the simulation, X was arbitrarily chosen as: 


X = (11.0, -2.0, 3.0) r inches 


(82) 


The unknown transformation a T° (the desired result of the simulation) is arbi- 


Choose X and *T° 


1 

Choose Orientation Components of w T‘ 0 - ) 

w'T'* t af~ns w'Y'a 
- 1 1 > -* 2 > x 3 

i 

Choose S 0 , Si, S 2 , S 3 

i 

Compute Translation Components of 
“T' Using Equation 15. 



Add Random Error to “T- 

I . 

Compute Error in W T‘ 


1 _ 

Iterate Equations 9 to Obtain ‘T° and X 

I 

Compute Error in ‘T° 


If Complete, Then Print Statistics 


Figure 16 : Flow Chart of the Simulation Procedure. 
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trarily chosen. By choosing *T°, it is possible to compute the remainder of the input 
data. When the input is known, equations 81 are solved. The result of equations 81 
is compared to the chosen S T° and X. 

When choosing transformations, it is important that they be consistent with 
the properties of transform matrices; therefore transforms are chosen by specifying 
screw matrix parameters. The screw axis, angle and displacement for matrix 'T° 
are chosen as: 


(-.5, .5, .707), 45°, (-2., 11., 3.) inches (83) 

These parameters produce the following transformation matrix: 

0.7803301 -0.5732233 0.2500000 -2.000000 ' 

0.4267767 0.7803301 0.4571068 11.00000 

-0.4571068 -0.2500000 0.8535534 3.000000 

0 0 0 1 

The next step is to compute the four matrices W T‘ that represent the manipu- 
lator’s sensor reference pose relative to the world when point i of the orientation 
fixture is placed at position X. The orientation component of these matrices can 
be arbitrarily selected without violating any kinematic equations. Therefore their 
screw axes and angles were selected as: 


= ’T° (84) 


(-.25, .5, .829), 30° 
(.5, .25, .829), 45° 
(.1,. 75, .654), -15° 
(.75, .1, .654), 50° 


(85) 


Next the positions of the targets on the orientation fixture are selected. Their 


positions relative to the orientation fixture are arbitrary so they were initially se- 
lected (in inches) as: 


The only unknown input data at this point axe the translation components of 
the matrices w T" i . These are calculated from the following equation: 

' y I e .1 ‘ 

^ = ™ R y T ° + Pi ( 87 ) 

Here W R‘ is a pure rotation transformation matrix equivalent to the orientation part 
of W T‘, and w p i ’ is the translation component of W T\. The solution of equation 87 
makes it possible to express the four W T‘ > matrices as: 


0.8743988 

0.3978313 

-0.2777715 

9.205970 

-0.4313249 

0.8995190 

-0.06945706 

-12.54899 

0.2222285 

0.1805429 

0.9581329 

-1.415914 

0 

0 

0 

1 

0.7803301 

0.6229137 

-0.0553495 

-3.125949 

-0.5496903 

0.7254126 

0.4142669 

-9.234571 

0.2982038 

-0.2928398 

0.9084709 

7.167713 


0.9662666 -0.1666693 

0.1717805 0.9850926 

-0.1918864 0.0425910 

0 0 


0.1963422 15.57589 

-0.009172767 -24.77669 
0.9804925 6.022668 

0 1 


uj rpa 


0.8437196 0.5276574 0.0985639 7.552853 

-0.4740756 0.6463597 0.5978891 -18.11831 

0.2517729 -0.5511776 0.7954959 14.91298 

0 0 0 1 
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The data in equations 86 and 88 can be used to iterate equations 81 to obtain 
the unknowns X and * T ° . Instead, measurement error is simulated to determine its 
effect on the solution. 

To simulate measurement error, the four matrices given in equations 88 are 
modified. A normally distributed random number is added to the components of 
the screw parameters given in equation 85. Eight normal deviates with zero mean 
and a chosen standard deviation (<r a = 0.001) are generated and added to the x 
and y components of the four screw axis parameters. The four z components are 
determined so that the axis vector is a unit length. Four new normal deviates with 
zero mean and standard deviation ag = 0.1° are generated and added to the four 
angles in equations 85. From the modified screw parameters, modified orientation 
parts for W T’ are determined. Finally, twelve more zero mean normal deviates 
with standard deviation <r p = 0.1 inches axe generated and added to the translation 
components of the matrices given in equation 88. One particular set of modified 
W T* matrices follow: 


0.8744398 

0.3971986 

-0.2785468 

9.366833 

-0.4311531 

0.8994911 - 

-0.07087093 

-12.54547 

0.2224006 

0.1820687 

0.9578043 

-1.347170 

0 

0 

0 

1 

0.7807935 

0.6223629 

-0.0550087 

-2.964712 

-0.5499712 

0.7264028 

0.4121537 

-9.225114 

0.2964677 

-0.2915537 

0.9094523 

7.144633 

0 

0 

0 

1 

0.9665945 

-0.1658109 

0.1954533 

15.52145 

0.1708459 

0.9852560 

-0.0090689 

-24.85198 

-0.1910678 

0.0421583 

0.9806711 

5.999934 

0 

0 

0 

1 

0.8436117 

0.5278046 

0.0986999 

7.633105 

-0.4738018 

0.6452208 

0.5993346 

-18.10223 

0.2526483 

-0.5523698 

0.7943906 

14.97786 

0 

0 

0 

1 


\d rpa 
X Om 


tup 


lm 


jrpa 
X 2m 


wrp, 


3m 


(89) 


From the four modified matrices of equation 89, equation 81 is solved for matrix 


*T°. In all cases, the initial estimate of X is zero. When the matrices in equation 89 
are used, the solution is: 


0.7847148 -0.5669553 0.2497151 

0.4280652 0.7875659 0.4436474 

-0.4483111 -0.2414573 0.8607085 

0 0 0 

The simulation results express the error between 
calculated as the one norm (sum of absolute values) of matrix difference, e.g. 
Error = ||Tc orrec t — TLcorrectH- To obtain statistics, the simulation of measure- 
ment error was repeated multiple times. At each iteration, the process started with 
the correct screw parameters in equations 85 and correct translation components 
of w T a in the fourth column of the matrices in equations 88. From this point, 
new random numbers were generated to determine modified W T‘ matrices. At each 


-1.892561 

11.01522 

2.918883 

1 


(90) 


matrices. Matrix error is 


iteration, errors in the modified and original W T‘ matrices were determined and 
recorded. After solution, the error between the computed and correct *T° matrix 
was computed and recorded. After n = 100 iterations, the average input data error 
was computed as the sum of the W T" errors divided by 4 n = 400. The mean solu- 
tion error was computed as the sum of ‘T° error divided by n = 100. The sample 
standard deviations were similarly computed. Typical results are in tables 1, 2 and 
3. 

Based on the results shown, the method can be used to complete the forward 
calibration problem when single point sensors are used. The solution error seems 
to be slightly sensitive to the orientation fixture target spacing and may require 
consideration in designing the fixture. The method of solution was a standard 
zero crossing algorithm. It may be possible to obtain more accurate results with 
a minimization algorithm. Since the introduction of measurement error may cause 
the equations to have no solution, the minimization problem may be better defined. 

In this work, the zero crossing algorithm was iterated 1000 times; if it did 
not reach convergence within that time, the last best estimate of X was used. 
The results given include the errors when the algorithm failed to converge. The 
algorithm used required the input of only four W T’ matrices; by collecting more 
data than necessary and averaging them, it may be possible to reduce the error 
in the result. To do this, one should define the problem as the minimization of 
an objective function, collect more data than necessary, and determine the best fit 
‘T° matrix. This is essentially what is done with many of the forward calibration 
algorithms. 


Table 1: Summary of Input Data and Results of the Simulation 


—* 

Correct x, y, z coordinates of X 

11. 

-2. 

3. 

Screw Parameters for W T‘ 


■ 


x, y , components of Screw axis, 9 

-.5 


45. 

x, y, z components of Displacement 

-2. 

Mm 

3. 

Coordinates of point 0 of Orientation fixture 

0 

0 

0 

Coordinates of point 1 of Orientation fixture 

10 

0 

0 

Coordinates of point 2 of Orientation fixture 

10 

10 

0 

Coordinates of point 3 of Orientation fixture 

0 

10 

0 

Screw Parameters for w Tg 




x, y, components of Screw axis, 9 

-.25 

.5 

30. 

Screw Parameters for W T\ 




x, y, components of Screw axis, 6 

.5 

.25 

45. 

Screw Parameters for W T S 2 




x, y , components of Screw axis, 9 

.1 

.75 

-15. 

Screw Parameters for w T‘ a 




x, y, components of Screw axis, 9 

.75 

.1 

50. 

Standard deviation for Screw axis 

0.001 


■ 

Standard deviation for Screw angle 


0.1 

■ 

Standard deviation for Displacement 



1 

Number of iterations 

100 


tm 

Input Data Mean and Standard Deviation 




Resulting Mean and Standard Deviation 


















Table 2: Summary of Input Data and Results of the Simulation 


Correct x, y, z coordinates of X 



3. 

Screw Parameters for W T‘ 




x , y , components of Screw axis, 0 

-.5 

1 

45. 

x, y , z components of Displacement 

-2. 

BS 

3. 

Coordinates of point 0 of Orientation fixture 

0 

0 

0 

Coordinates of point 1 of Orientation fixture 

10 

0 

0 

Coordinates of point 2 of Orientation fixture 

10 

10 

0 

Coordinates of point 3 of Orientation fixture 

0 

10 

0 

Screw Parameters for W T 3 




x, y, components of Screw axis, 0 

-.25 

.5 

30. 

Screw Parameters for W T{ 




x , y, components of Screw axis, 0 

.5 

.25 

45. 

Screw Parameters for W T’ 2 




x, y, components of Screw axis, 0 

.1 

.75 

-15. 

Screw Parameters for W T* 3 




®, t/, components of Screw axis, 0 

.75 

.1 

50. 

Standard deviation for Screw axis 




Standard deviation for Screw angle 




Standard deviation for Displacement 



0.1 

Number of iterations 




Input Data Mean and Standard Deviation 

0.245 

esqi 


Resulting Mean and Standard Deviation 

0.752 

H 

















Table 3: Summary of Input Data and Results of the Simulation 


Correct x, y, z coordinates of X 

11. 

-2. 

3. 

Screw Parameters for w T a 


1 


x, y, components of Screw axis, 6 

-.5 

B 

45. 

x, y , z components of Displacement 

-2. 

D 

3. 

Coordinates of point 0 of Orientation fixture 

0 

0 

0 

Coordinates of point 1 of Orientation fixture 

5 

0 

0 

Coordinates of point 2 of Orientation fixture 

5 

5 

0 

Coordinates of point 3 of Orientation fixture 

0 

5 

0 

Screw Parameters for w T a 0 




x , y , components of Screw axis, 6 

-.25 

.5 

30. 

Screw Parameters for W T[ 




x, y, components of Screw axis, 0 

.5 

.25 

45. 

Screw Parameters for W T a 2 




x, y, components of Screw axis, 6 

.1 

.75 

-15. 

Screw Parameters for w T a 3 




x , y, components of Screw axis, 6 

.75 

.1 

50. 

Standard deviation for Screw axis 

0.001 



Standard deviation for Screw angle 




Standard deviation for Displacement 



0.1 

Number of iterations 

100 



Input Data Mean and Standard Deviation 


■uWw 


Resulting Mean and Standard Deviation 



















2.5.4 Conclusions 


This work demonstrated how nonphysical single point sensors can gather suf- 
ficient position information to complete a forward kinematic calibration. Single 
point sensors, which can measure the position of only one point fixed to the tool of 
the manipulator, have several advantages over other types. They axe simpler, less 
expensive, highly accurate, and can provide feedback to the manipulator controller. 
This feedback often consists of “go”, “no-go” type information that can be easily 
interfaced to digital input lines of the control system. The feedback can “drive” the 
manipulator automatically, enabling the automatic collection of calibration data. 

Single point sensors have been used successfully for forward kinematic calibration 
but have been unable to compute the correct orientation of the tool. In addition, 
some single point sensors are nonphysical, which means they cannot be accurately 
located relative to the tool. Using nonphysical sensors presents difficulty because 
the forward calibration can compute the pose of the sensor only and not of the tool. 

The method presented utilizes a fixture held in the tool and the single point 
sensing system fixed in the workspace to complete the forward calibration. The 
method can be performed with any manipulator and produces accurate results even 
in the presence of measurement errors. 

New sensor designs may relax the need for accurate position sensing. With this 
method, it is possible to perform accurate manipulator calibration with a sensor 
system that produces repeatable results, not necessarily accurate measurements. 
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